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INTRODUCTION 

PID (proportional, integral, derivative) compensation is one of the most common forms of closed-loop 
control. Control of closed-loop systems that require compensation is a growing area of application for 
embedded microprocessors. In these systems, analog signals must be converted into discrete digital 
samples before compensation or filtering can take place. Loop performance dictates the sampling rate, 
and calculations must be complete before the next sample time begins. These loop-related constraints 
and the Nyquist frequency requirement place an upper bound on digital control of closed systems with 
feedback error. If the controlled system has a resonance or other behavior with a time constant shorter 
than the sample and calculation time, chaos is the most likely outcome. Despite these limitations, 
increases in microprocessor clock rates and the addition of on-chip control-oriented hardware are 
expanding the number of medium performance control applications handled by 8-bit machines. While an 
expensive DSP-class processor is the correct choice for the most demanding applications, several 
members of the M68HC1 1 family have the speed and resources to control multiple PWM channels. 

This note provides two working examples of PID control-loop software. The first example, written primarily 
in C, shows a PID algorithm in a straightforward way using floating-point math. Key features of the C 
environment are covered for readers who are more used to assembly language. The second example 
implements a PID algorithm in assembly language. It uses the MC68HC1 1 N4 on-chip math coprocessor to 
speed up arithmetic operations. 

Both examples are complete and ready to run on a Motorola M68HC1 1 EVS evaluation board. External 
interfacing is identical for both examples — an 8-bit analog to digital converter is used for input, and an 
8-bit PWM waveform is output. Because the code in both examples carries more than 16 bits of precision, 
and because both processors support 16-bit PWM, only minor changes are needed to increase precision. 
Power amplifiers, sensors, and other interface circuitry must be supplied in order to experiment with real- 
world systems — a simple RC circuit is used for software checkout. 

C and assembly language source code and loadable object code can be obtained by calling the Motorola 
FREEWARE Bulletin Board Service at (512) 891-3733. The FREEWARE BBS operates 24 hours a day, 7 
days a week, except for brief periods when it is down for maintenance. The BBS serial format is 300-2400 
BAUD, 8 data bits, 1 stop bit, and no parity. 




The MC68HC11K4 and MC68HC11N4 are 16-MHz devices with nonmultiplexed external address and 
data buses. Each has 24 Kbytes of on-chip ROM or EPROM. Both devices have multiple PWM channels 
with programmable period, duty cycle, polarity, and clock source. In both, two 8-bit channels can be 
concatenated to generate a 16-bit PWM output. The MC68HC11N4 also has two additional 12-bit PWM 
channels and two digital to analog converter channels with 8-bit resolution. 

The MC68HC11N4 is particularly well-suited to PID computation because it has an on-chip math 
coprocessor that performs 16- and 32-bit multiplication and division, fractional division, and multiply-and- 
accumulate operations. All operations are done by means of memory-mapped registers, thus preserving 
the standard M68HC1 1 family instruction set. Multiplication and fractional division are complete in a 
maximum of 5 microseconds while integer division requires a maximum of 8.75 microseconds. 



PID ALGORITHM 

The general flow of a controlled system with PID compensation is shown in Figure 1 . References 2 and 3 
provide a complete analysis of digital PID control, but it is worthwhile here to informally review the 
derivation of the discrete forms of each term and how they function. 
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DIGITAL PID BLOCK 



Figure 1. PID Flow Diagram 

There is a desired setpoint in our process (Gd) and a measurement of the actual value G(t) in time. Error is: 

e(t) = Gd-G(t) 
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Output correction x(t) for the PID controller is: 

x(t) = KPe(t) + Kl f e(t) dt + KD It = T 
J dt 



where KP, Kl, and KD are constants. 
Now, rewriting the integral: 



t 

x(t) = KPe(t) + Kl J [Gd-G(t)] dt + KD |t = T 
t=o 



To introduce discrete time, let t = kT where k = 1,2, ...,n and T = the sampling and control update period. 
Now, to = (k - 1 )T. The integral evaluated from (k - 1 )T to kT can be approximated using the trapezoidal 
integration rule. The derivative of the error term is simply the rate of change of error, but this can be noisy 
over one period. Using a four-point central-weighted average for the difference term is a practical way to 
deal with this on a microprocessor. 

The form which can be executed directly on the microprocessor is: 



x(t) = KPe(t) + Klf Gdt-I(G(Kt)-^ 



This term is added to the current output and put into the PWM control register at the beginning of the next 
calculation cycle. Substituting the microcode labels for constants and variables into EQ. 4 and using C 
language operator notation gives: 

NEWDTY = KP * (ERRX) + Kl * PERDT * (CMNDX - (ADRCX + ADRCXM1 ) / 2) + (KD / (6 * PERDT)) * 
((ERRX - ERRM3X) + 3 * (ERRM1X- ERRM2X)) + OLDDTY 

The function of the proportional term is clear, but the derivative and integral terms may need a brief 
explanation. When a system with only proportional control is off the specified setpoint, the controller will 
increase the control voltage until the error signal is zero, and the system thus returns to the setpoint with 
more applied voltage than is required for maintaining equilibrium. This causes overshoot and, as the 
process continues, under-damped ringing. The derivative term contributes proportionally to the error rate 
of change, but with the opposite sign of the proportional term. If the proper constants are chosen, critical 
damping can be achieved. The role of the integral term is to eliminate steady state error. A system that 
has a steady state error when tracking a ramping input function can use an integral term to integrate the 
error over time and compensate for it. 
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C LANGUAGE IMPLEMENTATION 



This version of the PID control routine illustrates use of high-level language for control applications. High- 
level language offers many conveniences not available in assembly language. Here are a few instances: 

Memory-mapped registers can be defined in a single file, which can be included in any function. 

Since C is a strongly-typed language, the compiler can identify data-type mismatches, such as writing 
a 16-bit integer to an 8-bit port. 

Most C compilers for the M68HC1 1 family allow direct vectoring to interrupt service routines. Interrupt 
functions are usually defined for a special memory segment with a base address and a function name: 

interrupt [INTVEC_START + 26] void RTI_interrupt(void) ; 

When an interrupt service routine is written it can be declared as an interrupt function instead of a 
normal subroutine: 

interrupt void RTMnterrupt(void) 

The function is compiled with a terminating RTI instruction, eliminating the need for a patch between 
hardware interrupts and C subroutines. The void statements indicate that no arguments are being 
passed to or from the interrupt routine. 

One of the most attractive features of contemporary C compilers is the ability to add floating point math 
with an "include math.h" statement. Even when the final application can't afford the time or code 
space for floating point calculations, use of floating point math during debugging provides an 
excellent means of testing new algorithms. 

Now to examine the control routine itself (refer to Appendix A for a complete C listing). After necessary 
files are included and floating point variables are declared, a prototype is given to define an assembly 
language function that is used later. 

The main program initializes constants and variables, sets up the required on-chip peripherals, and waits 
for interrupts to occur. The M68HC1 1 real-time interrupt (RTI) is used to establish a precise time base for 
performing PID compensation. The period (T or PERDT) is determined by the RTI rate. In these 
examples, the period is 16.383 milliseconds, but this value is arbitrary — in real applications, the 
performance of the controlling microprocessor and the requirements of the controlled system determine 
the period. 

The RTI_interrupt function is a workhorse. It does PID loop PWM duty cycle calculations, performs I/O 
using the DOIO assembly language function, and checks the results against the usable PWM output 
range of $00 to $FF. 1f a floating-point result is out of range, the closest limit is substituted. This 
"saturation arithmetic" prevents out-of-range results from causing sign-reversals in the PWM output. 

Details of error-checking and the DOIO subroutine are best understood by looking at the format of the 
floating-point variables. The four byte format is: 

SEEEEEEE EMMMMMMM MMMMMMMM MMMMMMMM 

S represents a sign bit, E represents an 8-bit exponent biased by 127, and M represents a 23-bit fractional 
mantissa (significand) with an implicit leading 1. The I/O range of $00 to $FF is scaled into the eight most 
significant bits of a floating-point variable, giving a floating-point range of 1.0 ($3F800000) to 
1.998046875 ($3FFF8000). The following expression is used to evaluate a floating-point number: 

F = [(-1) s ] [2( £ - 127 )][1.M] 



When the RTI_interrupt function returns control to the C routine, the last task the routine must perform is 
preparation for the next period. A two-element pipeline of the A/D reading and a four-element error 
pipeline are updated. Finally the "old" duty cycle value is copied into OLDDTY. 
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MC68HC11N4 MATH COPROCESSOR 

The assembly PID routine uses the MC68HC11N4 math coprocessor, which is commonly referred to as an 
arithmetic logic unit, or ALU. A brief description of the coprocessor will aid in understanding how the 
routine functions. 

The ALU performs 32/16-bit division, 16/16 multiplication, multiply-and-accumulate operations, and 
16/16-bit fractional division without CPU intervention. The coprocessor has one control register, one 
status register, and three data registers. The 8-bit ALU control register (ALUC) controls ALU operation. 
The 8-bit ALU status register (ALUF) signals when an operation is complete and indicates the status of the 
completed operation. Data register A (AREG) can hold either a 16-bit multiplicand or a 16-bit divisor. Data 
register B (BREG) can hold either a 16-bit multiplier or a 16-bit remainder after division. Data register C 
(CREG), which is treated as two 16-bit registers (CREG High and CREG Low), can hold a 32-bit product or 
accumulated product after multiplication, or it can hold a 32-bit numerator before division and a 32-bit 
quotient after division. There is an implied fixed radix point to the right of bits AREGO, BREGO, and 
CREGO. 

Figure 2 shows coprocessor registers. Arrows indicate the most convenient order of writing the registers. 
A description of ALUC and ALUF bit functions follows. Figure 3 shows typical data register formats. Table 
1 shows numeric ranges of ALU registers. Table 2 shows signed expression of numbers. Table 3 shows 
fractional numeric representation. 



ALU REGISTERS 



MAC 



MUL 



DIV 



FDIV 



$_040 
$_041 
$_042 
$_043 
$_044 

$_045 
$_046 

$_047 
$_048 
$_049 



-(CREG HIGH)- - 

-CREG 

•(CREG LOW) - - 



ALUC 



AREG 



BREG 



ALUF 



32 BITS 



8 BITS 



16 BITS 



16 BITS 



8 BITS 



START 
FDIV 



1 START 

DIVISION 



T START 
MULTIPLY 



Figure 2. Coprocessor Registers and Operations 




ALUC 



— Arithmetic Logic Unit Control 



$0044 



RESET: 



Bit 7 


6 


5 


4 


3 


2 


1 


Bit 


SIG 


DIV 


MAC 


DCC 


TRG 

































SIG — Signed Number Enable 

= AREG, BREG, and CREG contents are unsigned numbers 

1 = AREG, BREG, and CREG contents are signed numbers 
DIV — Division Enable 

MAC — Multiply with Accumulated Product Enable 
DCC — Division Compensation for Concatenated Quotient Enable 
TRG — Function Start Trigger Bit 
Always reads zero 

= No effect 

1 = Start ALU 

Bits [2:0] — Not implemented 
Always read zero 



SIG 


DIV 


MAC 


DCC 


FUNCTION 


START TRIGGERS 











X 


Unsigned MUL 


Write BREG or set TRG 


1 








X 


Signed MUL 


Write BREG or set TRG 








1 


X 


Unsigned MAC 


Write BREG or set TRG 


1 





1 


X 


Signed MAC 


Write BREG or set TRG 









A 


Unsigned IDIV 


Write AREG or set TRG 


1 


1 








Signed IDIV 


Write AREG or set TRG 


1 


1 





1 


Signed IDIV DCC 


Write AREG or set TRG 





1 


1 


X 


Unsigned FDIV 


Set TRG 


1 


1 


1 





Signed FDIV 


Set TRG 


1 


1 


1 


1 


Signed FDIV DCC 


Set TRG 



ALUF — Arithmetic Logic Unit Status Flag Register $ 4 9 



Bit 7 


6 


5 


4 


3 


2 


1 


Bit 


NEG 


RZF 








OVF 


DZF 


ACF 



























NEG — Negative Result 

NEG is set if the result is a negative value. This is a read-only-bit. Writes to this bit do not affect the 
value. 

RZF — Remainder Equals Zero Flag 

RZF is set if the remainder is zero. 
Bits [5:3] — Not implemented 

Always read zero 
OVF — Overflow Flag 

OVF is set if overflow from MSB on CREG is detected. This bit is cleared automatically by a write to 

this register with bit 2 set. 
DZF — Divide by Zero Flag 

DZF is set if a divide by zero condition is detected. DZF is cleared automatically by a write to this 

register with bit 1 set. 
ACF — Arithmetic Completion Flag 

ACF is set by completion of the arithmetic operation. ACF is cleared automatically by a write to this 

register with bit set. 
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32-BIT SIGNED INTEGER NUMBER 



31 



16 



T 



CREG HIGH 



15 



CREG LOW 



'SIGN BIT 
16-BIT SIGNED INTEGER NUMBER 



INTEGER- 
CREG 

15 



INTEGER 



16-BIT FRACTION NUMBER AFTER FDIV 



SIGN BIT 

AREG or BREG 



-1 



-16 



AA 



FRACTION 



-2147483648 
TO 

' +2147483647 
RADIX POINT 



-32768 
TO 

^ 32767 
RADIX POINT 



0.00000 

TO 
0.99998 



CREG LOW 
RADIX POINT 

SIGN BIT IS IN INTEGER PART OR NEG FLAG 
32-BIT SIGNED INTEGER AND FRACTION FOLLOWING AN FDIV 

15 -1 



T 

le 



INTEGER 



CREG HIGH 



-16 



FRACTION 



'SIGN BIT 

CREG 

LONG WORD SIGNED RESULT AFTER FDIV FOLLOWING AN IDIV 



^ CREG LOW 
RADIX POINT 



-32768.99998 
TO 

+32767.99998 



31 



16 



CREG HIGH AFTER IDIV 



15 



CREG LOW AFTER IDIV 



SIGN BIT 



INTEGER - 
CREG 



Si 



RADIX POINT 



15 



-1 



i 



S CREG HIGH AFTER FDIV 



SIGN BIT 



INTEGER 



-16 



CREG LOW AFTER FDIV 



-FRACTION- 



RADIX POINT 
CREG 



Figure 3. ALU Data Register Format 
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Table 1. Numeric Ranges of ALU Registers 



Register 


Size 


Unsigned 


Signed 


AREG 


1 6 bits 


to 65535 


-32,768 to +32,767 


BREG 


16 bits 


to 65535 


-32,768 to +32,767 


CREG 


32 bits 


to 4,294,967,295 


-2,147,483,648 to +2,147,483,647 



Table 2. Signed Numbers 



Decimal 


16-Bit Hexadecimal 


32-Bit Hexadecimal 


+2,147,483,647 




$7FFFFFFF 


• 




• 


• 






+32,767 


$7FFF 


$0000 7FFF 


• 


• 


• 


• 


• 


• 


+1 


$0001 


$0000 0001 





$0000 


$0000 0000 


-1 


$FFFF 


$FFFF FFFF 


-2 


$FFFE 


$FFFF FFFE 


• 


• 


• 


• 


■ 


• 


—32,768 


$8000 


$FFFF 8000 


• 




• 






• 


-2,147,483,647 




$8000 0000 




MOTOROLA 
8 



AN1215/D 



Table 3. Fractions 



Decimal 


16-Bit Hexadecimal 


+0.99998 


$FFFF 


• 


• 


• 


• 


+0.5 


$8000 


+0.25 


$4000 


+0.125 


$2000 


+0.0625 


$1000 


+0.03125 


$0800 


+0.015625 


$0400 


• 


• 


• 


• 


+0.0000153 


$0001 


-0.99998 


$0001 


• 


• 


• 


• 


-0.5 


$8000 


-0.25 


$C000 


-0.125 


$E0OO 


-0.0625 


$F000 


-0.03125 


$F800 


-0.015625 


$FC00 








• 


-0.0000153 


$FFFF 
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ASSEMBLY LANGUAGE IMPLEMENTATION 

The assembly language version of the PID control routine consists of a C master program and an assembly 
subroutine (DOPID) that carries out all time-critical tasks (see Appendix B for a complete listing). The C 
master program is used for convenience — DOPID can be made to stand alone with minor changes in 
variable definition. 

The constant and variable number representation for the assembly version of the PID loop is a four-byte 
number consisting of a 16-bit integer, an implied decimal point, and a 16-bit fraction. This representation 
was chosen to provide relatively high performance while giving enough precision to support 
MC68HC11N4 8-, 12-, and 16-bit PWM resolutions. Many other formats could be used, each with a 
particular trade-off between precision and time. 

Although the sampling period constant and the constants of each term of the PID algorithm could be 
calculated during the assembly phase and set in the final code, these values are instead initialized as ratios 
of hexadecimal integers, then calculated in real time in the loop. This arrangement allows easy 
experimentation with these values without reassembling each time a value is changed. The initial format of 
these values (numerator and denominator) is a consequence of the four-byte numeric representation. 

Here are some examples of ALU operations performed during PID computation. 

To perform a signed integer divide followed by a signed fractional divide, the numerator is written to 
CREG, $C0 is written to ALUC, and the divisor is written to AREG. After the completion flag in ALUF is 
set ($49), $E8 is written to ALUC. Following integer division, the quotient is in CREG and the 
remainder is in BREG. Fractional division moves the content of CREG Low to CREG High, then places 
a 16-bit fraction in CREG Low. The final result is a 16-bit quotient in CREG High and a 16-bit fraction in 
CREG Low. There is an implicit decimal point between CREG High and CREG Low. More precision 
can be obtained by concatenating fractional divisions. 

To perform a signed multiply, $80 is written to ALUC and multiplicands are written to AREG and BREG. 
When the operation is complete, a 32-bit result is in CREG. 

The actual range used for control is hexadecimal $0000.0000 to $00FF.FFFF (decimal to 255.99998). 
While the error term can be positive or negative, PWM output and feedback voltage are always positive. A 
result greater than $FF is treated as an overflow, and a result less than $00 is treated as an underflow. This 
effects a saturated value of the correct sign as in the C version. Except for the expression of initial 
constants as ratios, formula 5 is not changed. In the derivative term the factor 

(KDNUM / KDDEN) / ((6 * (PERDTNUM / PERDTDEN)) 

is rearranged to 

((KDNUM / KDDEN) * PERDTDEN) / (6 * PERDTNUM). 

The DOPID routine is written as straight-line code. Only two subroutines and a limit-checking section are 
shared by the proportional, integral, and derivative terms. The subroutines MULLNG and ADLNG are 
used to multiply and add terms and factors expressed in the special four-byte format explained previously. 
Each of the P, I, and D terms use ADLNG to contribute to the new PWM duty cycle (NEWDTY), but, as in 
the C version of the PID routine, NEWDTY is not output until the beginning of the next period. Only the 
8-bit integer portion is. used, and the 1-bit round-off error this causes is not corrected — the effect is 
negligible in this 8-bit example. After all three terms are calculated, control is returned to the master C 
routine. The master routine updates the error and A to D pipelines, then enters the main wait loop. 

During program execution, all results and most intermediate values are kept in RAM, rather than on the 
stack. Controller state can easily be inspected by means of a single breakpoint and a dump of the 
appropriate variable address. Variable addresses are provided in the C startup code for the assembly 
routine — the addresses are only valid for this compilation and can change with code revision. 
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HARDWARE PLATFORM 

The Motorola M68HC1 1 KMNPEVS Evaluation System can be used to run both versions of the PID 
routine. With an MC68HC11K4 inserted in the emulator module, only the floating point version will 
execute. With an MC68HC11N4 inserted, both versions can be executed — the floating point version 
simply does not use the math coprocessor. 

Both versions of the PID routine utilize special test mode in the EVS system. This means that the 
M68HC1 1 processor vectors are mapped from $BFD6 to $BFFF instead of from $FFD6 to $FFFF, and can 
be placed in user RAM or in emulation RAM, making experimentation with varied processor configuration 
options easier. Refer to the M68HC11 KMNPEVS Evaluation System User's Manual for more information. 

S-record formatted object code can be loaded and run on the EVS using appropriate serial 
communications software. The default EVS Baud rate is 19200 Baud. 

A simple RC circuit is used to provide the feedback necessary for the software PID loop to operate. The 
connections to the EVS are shown in Figure 4. PHO is the processor PWM output and PEO is the cha nnel 
1 A/D input. Note that the A/D reference inputs must be connected to appropriate supplies and the IRQ 
line must also be tied high. A two-channel oscilloscope can be used to observe PWM output and 
controlled voltage. Both versions of the code write $FF to PORTA just before performing PID loop 
calculations and then write $00 to the port just after calculations are complete, allowing execution times to 
be observed with a scope. 




M EVS TEST SCHEM 



Figure 4. Evaluation System Schematic 
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PERFORMANCE 



Since two very different approaches were taken to implement the PID loop algorithm, it is not surprising 
that the performance and code sizes of the two routines differ significantly. The C language version 
contains over 1500 bytes, much of which consists of floating point runtime support. Because it carries full 
floating-point precision and does not use math support hardware, the C version takes approximately 6 
milliseconds to complete the loop. The assembly version contains approximately 1000 bytes, and could 
be reduced to about 800 bytes if features added for clarity and experimentation were removed. Because 
it uses a tailored arithmetic format and gets a hardware assist from the math coprocessor, the assembly 
version completes the loop in approximately 700 microseconds. In both cases, performance could be 
improved by precomputing all the results with constant factors. 



EXPERIMENTS AND EXTENSIONS 

To develop a more intuitive understanding of PID loop function, try varying the term constants in the 
object code and observing the effect on controller performance. For the C version, it is best to change 
the values in the C source and recompile. For the assembly version, it is easy to recalculate and change 
denominators of the constants: only decimal-to-hex conversion is required. The PERDT constant must 
be changed when the RTI interrupt rate is changed, or the time base of the algorithm will be destroyed. 
Try adjusting the proportional and derivative constants to give good observable control and then start 
substituting smaller value resistors for R1. Eventually, the substitution will cause an unstable 
underdamped system. 

Many extensions to the routines are simple yet interesting. The command voltage level can be read from 
one of the seven unused A/D channels to give real-time control points. The MC68HC1 1 N4 version could 
have analog output instead of PWM with the use of an 8-bit D/A channel. The N4 version could also use 
an infinite impulse response (IIR) filter implemented by means of the math coprocessor multiply-and- 
accumulate capability, rather than utilizing the noise-canceling effect of the derivative term's four point 
central difference. 



CONCLUSIONS 

With the 16.383 millisecond sampling rate chosen, the floating point C routine cannot service all four 
MC68HC11K4 PWM channels. It could, however, service one higher-rate channel and several less time- 
critical processes. The assembly math coprocessor routine can service all the MC68HC11N4 PWM 
channels (four 8-bit and two 12-bit) in 4.2 milliseconds, leaving 75% of execution time for other tasks. If 
the MC68HC11N4 D/A channels were also used, six independent PID controllers could be run in 5.6 
milliseconds — this routine would use less than a third of the allowable processing time and require only 
half of the twelve MC68HC11N4 A/D input channels. 

The two approaches to PID control outlined in this note encompass a wide range of useful and cost- 
effective applications. The simplicity of the coded C algorithm is very appealing. Since the C routine 
carries virtually no code-space overhead, it is very well-suited to an application where floating-point math is 
already required, and a sampling rate in the 20-millisecond range is acceptable. Because it uses a number 
format adapted to the application and to use of on-chip resources, the assembly routine generally yields 
higher, more cost-effective performance than the C routine. 

A final word of caution. There is no substitute for thorough mathematical analysis of the system to be 
controlled in the discrete time domain. References 2 and 3 contain detailed discussions of control 
systems and analytic techniques. 
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APPENDIX A 
C LANGUAGE PID ROUTINE 



A.1 Main C Routine 

♦include <stdio.h> 
♦ include <io6811k4.h> 
♦include <int6811k.h> 
♦include <math.h> 



zpage 


unsigned 


int 


TOFCOUNT; 


zpage 


float 




CMNDVX; 


zpage 


float 




ADRCX; 


zpage 


float 




ADRCXM1 ; 


zpage 


float 




ADRCXM2 ; 


zpage 


float 




ADRCXM3 l 


zpage 


float 




ERRX; 


zpage 


float 




ERRM1X; 


zpage 


float 




ERRM2X; 


zpage 


float 




ERRM3X; 


zpage 


float 




PERDT; 


zpage 


float 




NEWDTY; 


zpage 


float 




OLDDTY; 


zpage 


float 




KP; 


zpage 


float 




KD; 


zpage 


float 




KI; 


extern 


int DOIO 


(void) 





/* declare variables */ 



/* prototype for assembly 
routine */ 



void mainO 

{ 

CMNDVX = 1.5; 

PERDT = 0.016383; 

KP = 0.18; 

KI = 6.0; 

KD = 0.009; 

OLDDTY = 1.9; 

PORTA = 0x00; 

DDRA = OxFF; 

PACTL = 0x03; 

TMSK2 = 0x40; 

OPTION = 0x90; 

PWPER1 = OxFF; 

PWDTY1 = OxFF; 

PWPOL = 0x01; 

DDRH = 0x00; 

PWEN = 0x01; 

TFLG2 = 0x4 0; 

enable_interrupt () ; 

wait_f or_interrupt () ; 

for (;;) { 
; } 

) 



/* main program */ 



/* RTI and therefore PID loop period = 16.383 ms */ 
/* kp = .12, ki = 6.0, kd = .006, for 1 M ohm drive 



/* start out with pwm set fairly high */ 

/* this will be used for a scope trigger 

/* set PORTA as output */ 

/* set RTI to 16.383 ms (E = 4 MHz) */ 

/* enable RTI interrupts */ 

/* enable A/D charge pump */ 

/* set up PWM channel 1 at 15.625 kHz */ 

/* with positive polarity */ 



/* wait here for RTI to cause loop execution */ 
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interrupt void IRQ_interrupt (void) /* should initialize all interrupts... */ 



PORTA = OxFF; 
PORTA = 0x00; 



interrupt void TO_interrupt (void) 



TOFCOONT++ ; 



interrupt void RTI_interrupt (void) 



/*PID LOOP/PWM routine */ 



PORTA = OxFF; 
DOIOO ; 



/* scope strobe */ 

/* read A to D and output the duty 
cycle calculated last period */ 



/* begin new conversion cycle */ 
/* calculate current error */ 



ADCTL « 0x10; 

ERRX = (CMNDVX - ADRCX); 

/* The statement below is the entire floating point PID loop */ 

NEWDTY = KP*(ERRX) + KI*PERDT* (CMNDVX - (ADRCX + ADRCXM1) /2) 

+ (KD/ (6*PERDT) ) * ( (ERRX - ERRM3X) + 3* (ERRM1X - ERRM2X) ) 
+ OLDDTY; 



if (NEWDTY > 1.99609) 
NEWDTY - 1.99609; 
else if (NEWDTY < 1.0) 
NEWDTY = 1.0; 

TFLG2 - 0x4 0; 
ADRCXM1 - ADRCX; 
ERRM3X = ERRM2X; 
ERRM2X = ERRM1X; 
ERRM1X = ERRX; 
OLDDTY - NEWDTY; 



/* test for result being in usable */ 
/* limits and set PWM duty cycle if */ 
/* beyond saturation */ 



/* clear RTI flag */ 

/* update A/D result for next cycle */ 
/* update error pipeline */ 



/* update old duty cycle for next 
calculation period */ 



PORTA = 0x00; 



/* scope strobe */ 
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A.2 DOIO Subroutine Assembler Listing 



1 

i. 








********************* 




2 




* 


DOIO assembly function 


* 


3 




* 


This routine handles the conversion between * 


4 




* 


8 bit register values and the C float variables * 


5 




* 






* 


6 
7 










********************* 


8 


0000 




MODULE 


DOIO 




9 


0000 




PUBLIC 


DOIO 




10 












11 


0000 




P68H11 






12 


0000 




RSEG 


CODE 




13 












14 


006C 


PWDTY1 


set 


$006c 


REGISTER LOCATIONS 


15 


0031 


ADDR1 


set 


$0031 




16 


0000 




EXTERN 


ADRCX:ZPAGE 


EXTERNAL VARIABLE LOCATIONS 


17 


0000 




EXTERN 


NEW3TY:ZPAGE 




18 


0000 


DOIO: 








19 


0000 863F 




LDAA 


#$3F 




20 


0002 5F 




CLRB 






21 


0003 DD00 




STD 


ADRCX 


INITIALIZE FLOAT LOCATION. 


22 


0005 9631 




LDAA 


ADR1 


GET CHANNEL 1 A/D RESULT. 


7"} 

^ j 


0007 04 




LSRD 




SHIFT TO FLOAT MANTISSA POSITION. 


24 


0008 8A80 




ORAA 


#$80 


OR IN LEAST SIGNIFICANT EXP BIT 


25 


00OA DD01 




STD 


ADRCX+1 


AND STORE IT IN FLOAT VARIABLE. 


26 


000C 5F 




CLRB 




CLEAR LEAST SIGNIFICANT 


27 


OOOD D703 




STAB 


ADRCX+3 


FLOAT BYTE. 


28 


OOOF DC01 




LCD 


NQCTY+l 


GET TWO BYTES OF FLOAT MANTISSA. 


29 


0011 05 




LSLD 




SHIFT TO CORRECT REGISTER POSITION 


30 


0012 976C 




STAA 


PWDTY1 


OUTPUT TO PWYI DUTY REGISTER. 


31 


0014 39 




RTS 






32 


0015 




END 
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APPENDIX B 
ASSEMBLY LANGUAGE PID ROUTINE 



B.1 Master C Routine 



/* This code just sets up variables and does some updates 
after the assembly PID loop is called. */ 

♦include <stdio.h> 
♦include <io6811N4.h> 
♦include <int 6811N . h> 





unsigned int 


TOFCOUNT; 


zpage 


signed int 


CMNDVX; 


zpage 


signed int 


ADRCX; 




1 t"> ana 


o t *r naf^ i r\ *t"" 

b-Lynea lnc 


ADRCXM1; 


zpage 


signea int 


ERRX; 




zpage 


signed int 


ERRM1X; 


zpage 


iJ.ynSO 


ERRM2X; 


zpage 


signed int 


ERRM3X 


f 


zpage 


signed int 


KPNOM; 




zpage 


signed int 


KPDEN; 




zpage 


signed int 


KINUM; 




zpage 


signed int 


KIDEN; 




zpage 


signed int 


KDNUM; 




zpage 


signed int 


KDDEN; 




zpage 


signed int 


PERDTNUM; 


zpage 


signed int 


PERDTDEN; 


zpage 


signed int 


INT56; 




zpage 


signed int 


FC5 6; 




zpage 


signed int 


TEMPI; 




zpage 


signed int 


TEMP2; 




zpage 


signed int 


TEMP 3; 




zpage 


signed int 


TEMP 1 ; 




zpage 


long 


NEWDTi; 


zpage 


long 


OLDDTY; 


zpage 


long 


KPTRM; 




zpage 


long 


KDTRM; 




zpage 


long 


KITRM; 




zpage 


long 


LTEMP1 




zpage 


long 


LTEMP2 




zpage 


long 


LTEMP3 




zpage 


long 


LTEMP4 




zpage 


long 


LTEMP5 




zpage 


long 


LTEMP6 




zpage 


long 


LTEMP7 




zpage 


long 


LTEMP8 




zpage 


long 


LTEMP9 




zpage 


long 


LTEMPA 




zpage 


long 


FCINT5 6; 


zpage 


long 


INTFC5 6; 


extern 


int DOPID (void) ; 







/* declare variables */ 



/* prototype for assembly 
routine */ 
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void main ( ) 

( 

CMNDVX = 0x0080; 
PERDTNUM - 0x0 0A4; 
PERDTDEN = 0x2710; 
KPNUM = 0x0 00C; 
KPDEN = 0x00 64; 
KINUM = 0x000 6; 
KIDEN = 0x0001; 
KDNUM = 0x0006; 
KDDEN = 0x03E8; 
OLDDTY =0x00FF0000; 
PORTA = 0x00; 
DDRA = OxFF; 
PACTL = 0x03; 
TMSK2 = 0x4 0; 
OPTION = 0x90; 
PWPER1 = OxFF; 
PWDTY1 = OxFF; 
PWPOL = 0x01; 
DDRH - 0x00; 
PWEN = 0x01; 
TFLG2 = 0x40; 

enable_interrupt () ; 

wait_f or_interrupt () ; 

for (;;) { 
; ) 



/* main program */ 

/* PERIOD = 164/10000 decimal */ 

/* kp = .12, ki = 6.0, kd = .006, for 1M ohm drive */ 



/* set PORTA as output */ 

/* set RTI to 16.383 ms (E = 4MHz) */ 

/* enable RTI interrupts */ 

/* enable A/D charge pump */ 

/* set up PWM channel 1 at 15.625 kHz */ 

/* with positive polarity */ 



/* wait for RTI to execute assembly PID routine */ 



interrupt void IRQ_interrupt (void) /* Just some traps for unexpected */ 

' /* interrupts */ 

PORTA = OxFF; 
PORTA = 0x00; 

} 



interrupt void TO_interrupt (void) 

{ 

TOFCOUNT++ ; 

) 

interrupt void RTI_interrupt (void) 

{ 

PORTA = OxFF; 
DOPID () ; 



/* PWM routine */ 

/* scope strobe */ 
/*DO THE PID LOOP USING THE MATH 
COPROCESSOR */ 



/* NEWDTY = KPMERRX) + KI*PERDT* (CMNDVX - (ADRCX + ADRCXMD/2) 

+ (KD/ ( 6*PERDT) ) * ( (ERRX - ERRM3X) + 3* (ERRM1X - ERRM2X) ) 
+ OLDDTY; */ 



TFLG2 = 0x4 0; 
ADRCXM1 = ADRCX; 
ERRM3X = ERRM2X; 
ERRM2X = ERRM1X; 
ERRM1X = ERRX; 
PORTA = 0x00; 



/* clear RTI flag */ 

/* update A/D result for next cycle */ 
/* update error pipeline */ 



/* scope strobe */ 




2 DOPID Assembly Listing 




i 




**************************************************************** 


2 




* DOPID assembly function * 


3 




* These routines calculate the new PWM duty cycle * 


4 




* using the 


MC68HC11N4 math coprocessor. The * 


5 




* code can be run on an M68HC11EVS with an * 


6 




* M68HC11K4 


emulator and MC68HC11N4 processor. * 


7 




* The EVS monitor should be 1.1 or later. The EVS * 


8 




* and vectors were set to SPECIAL TEST MODE to aid debug. * 


9 




* This code 


is called by a C routine but could be converted * 


10 




* to an all 


assembly environment by defining the variables * 


11 




* in assembly instead of as externals. * 


12 




**************************************************************** 


13 
14 


0000 


MODULE 


DOPID 


15 
16 


0000 


PUBLIC 


DOPID 


17 


0000 


P68H11 




18 


0000 


RSEG 


CODE 


19 








20 


006C 


PWDTY1 set 


$006c 


21 


0030 


ADCTL set 


$0030 


22 


0031 


ADR1 set 


$0031 


23 


0040 


CREGH set 


$0040 


24 


0041 


CREGMH set 


$0041 


25 


0042 


CREGML set 


$0042 


26 


0043 


CREGL set 


$0043 


27 


0044 


ALUC set 


$0044 


28 


0045 


AREGH set 


$0045 


29 


0046 


AREGL set 


$0046 


30 


0047 


BREGH set 


$0047 


31 


0048 


BREGL set 


$0048 


32 


0049 


ALUF set 


$0049 


33 








34 








35 








36 








37 


0000 


EXTERN 


ADRCX : ZPAGE $0084 EXTERNAL VARIABLES 


38 


0000 


EXTERN 


ADRCXM1 : ZPAGE $008 6 SIGNED INTS 


39 


0000 


EXTERN 


CMNDVX:ZPAGE $0082 


40 


0000 


EXTERN 


ERRX : ZPAGE $00 8 8 


41 


0000 


EXTERN 


ERRM1X: ZPAGE $008A 


42 


0000 


EXTERN 


ERRM2X : ZPAGE $008C 


43 


0000 


EXTERN 


ERRM3X: ZPAGE S008E 


44 


0000 


EXTERN 


KPNUM: ZPAGE $0090 


45 


0000 


EXTERN 


KPDEN: ZPAGE $00 92 


46 


0000 


EXTERN 


KINUM : ZPAGE $0094 


47 


0000 


EXTERN 


KIDEN: ZPAGE $00 96 


48 


0000 


EXTERN 


KDNUM : ZPAGE $0098 


49 


0000 


EXTERN 


KDDEN: ZPAGE S009A 


50 


0000 


EXTERN 


PERDTNUM: ZPAGE $009C 


51 


0000 


EXTERN 


PERDTDEN: ZPAGE $009E 


52 


0000 


EXTERN 


INT56: ZPAGE S00A0 


53 


0000 


EXTERN 


FC56: ZPAGE $00A2 


54 


0000 


EXTERN 


TEMPI: ZPAGE $00A4 


55 


0000 


EXTERN 


TEMP 2 : ZPAGE S00A6 


56 


0000 


EXTERN 


TEMP 3 : ZPAGE S00A8 


57 


0000 


EXTERN 


TEMP 4: ZPAGE $00 AA 


58 


0000 


EXTERN 


KPTRM: ZPAGE $00B4 LONGS 


59 


0000 


EXTERN 


KITRM: ZPAGE S00BC 


60 


0000 


EXTERN 


KDTRM: ZPAGE S00B8 


61 


0000 


EXTERN 


LTEMP1: ZPAGE S00C0 


62 


0000 


EXTERN 


LTEMP2: ZPAGE S00C4 


63 


0000 


EXTERN 


LTEMP3: ZPAGE S00C8 


64 


0000 


EXTERN 


LTEMP4 : ZPAGE S00CC 


65 


0000 


EXTERN 


LTEMP5 : ZPAGE S00D0 


66 


0000 


EXTERN 


LTEMP 6 : ZPAGE S00D4 



67 
68 
69 
70 
71 
72 
73 
74 
75 
76 
77 
78 
79 
80 
81 
82 
83 
84 
85 
86 
87 
88 
89 
90 
91 
92 
93 
94 
95 
96 
97 
98 
99 
100 
101 
102 
103 
104 
105 
106 
107 
108 
109 
110 
111 
112 
113 
114 
115 
116 
117 
118 
119 
120 
121 
122 
123 
124 
125 
126 
127 
12 8 
129 
130 
131 
132 
133 
134 
135 



0000 


EXTERN 


LTFMP7 * 7PAPF 


$00D8 


0000 


EXTERN 


T.TFMPP • 7Darir 


$00DC 


0000 


V YTT7T3W 


LilbMF y : ZPAGE 


$00E0 


0000 


EXTERN 


—J X i— < i » IT t £j c n 




0000 


EXTERN 


FCINT5 6:ZPAGE 


S00E8 


0000 


EXTERN 


INTFC5 6:2PAGE 


S00EC 


0000 


EXTERN 


OLDDTY: ZPAGE 


S00B0 


0000 


EXTERN 


NEWDTY: ZPAGE 


$00AC 


0000 


DOPID: 








******** OUTPUT 


LAST PERIOD RESULT AND 


DO KP 



0000 9601 LDAA NEWDTY+1 

0002 97 6C STAA PWDTY1 

0004 4F CLRA 

0005 D631 LDAB ADR1 
0007 DD00 STD ADRCX 
0009 C610 LDAB #$10 
00OB D730 STAB ADCTL 
000D DC00 LDD CMNDVX 
000F 9300 SUBD ADRCX 
0011 DD00 STD ERRX 
0013 2B06 BMI NFLAG1 
0015 8600 LDAA #$00 
0017 9700 STAA TEMP 3 
0019 2004 BRA NFLGG2 
001B 86FF NFLAG1 LDAA #$FF 
001D 9700 STAA TEMP 3 
001F 8680 NFLGG2 LDAA #$80 
0021 9744 STAA ALUC 
0023 DC00 LDD ERRX 
0025 DD45 STD AREGH 
0027 8601 LDAA #$01 
002 9 97 4 9 STAA ALUF 
002B DCOO LDD KPNUM 
002D DD47 STD BREGH 

002F 134901FC WPMUL1 BRCLR ALUF, #$01, WPMUL1 

0033 86C0 LDAA #$D0 

0035 DD44 STD ALUC 

0037 8601 LDAA #$01 

0039 9749 STAA ALUF 

003B DCOO LDD KPDEN 

003D DD45 STD AREGH 

003F 134901FC WPDIV1 BRCLR ALUF, #$0 1 , WPDIV1 

0043 8601 LDAA #$01 

0045 9749 STAA ALUF 

0047 86E8 LDAA #$E8 

0049 DD44 STD ALUC 

004B 134901FC WPFDV1 BRCLR ALUF, #$01 , WPFDV1 

004F DC40 LDD CREGH 

0051 DDOO STD KPTRM 

0053 DDOO STD LTEMP1 

0055 DC42 LDD CREGML 

0057 DD02 STD KPTRM+2 

0059 DD02 STD LTEMP1+2 

005B BD0361 JSR ADLNG 

005E BD007F JSR DOKIT 

0061 BD014F JSR DOKDT 

0064 DCOO LDD NEWDTY 

0066 2B0F BMI JAMZP 

0068 1A8300FF CPD #$00FF 

006C 2310 BMI KXDONE 

006E CCOOFF LDD #$00FF 

0071 DDOO STD NEWDTY 

0073 DDOO STD OLDDTY 

0075 2007 BRA KXDONE 

0077 CC0000 JAMZP LDD #$0000 

007A DDOO STD NEWDTY 

007C DDOO STD OLDDTY 

007E 3 9 KXDONE RTS 



OUTPUT PREVIOUS CALC . 



GET CHANNEL 1 A/D RESULT. 

DO KP TERM 

FIRST START NEW A/D 

CONVERSION 

FORM ERROR TERM 

SET UP SIGN FLAG IN TEMP3 
POS 



NEG 

SET ALU FOR SMUL 
CLEAR ACF 



TRIGGER SMUL 
WAIT FOR ACF 
SET ALU FOR SIDIV 

CLEAR ACF 



TRIGGER SIDIV 
WAIT FOR ACF 
CLEAR ACF 

TRIGGER SFDIV 

WAIT FOR ACF 

GET INT PART OF RESULT 



GET FRACTION 



NOW ADD TO OLDDTY 
DO I TERM, ADD TO OLDDTY 
DO D TERM, ADD TO OLDDTY 
CHECK LIMITS 



JAM FF 

SATURATED HIGH 



JAM 00 

SATURATED LOW 
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136 














137 






* ROUTINE TO DO 


INTEGRAL TERM * 




138 














139 


007F 


DCOO 


DOKIT 


LDD 


ADRCX 


GET CORRENT CONVERSION 


140 


0081 


D300 




ADDD 


ADRCXM1 


FORM (ADRCX + ADRCXMD/2 


141 


0083 


04 




LSRD 






142 


0084 


DDOO 




STD 


LTEMP2 




143 


0086 


2507 




BCS 


JMHAFI 




144 


0088 


CCOOOO 




LDD 


#$0000 




145 


008B 


DD02 




STD 


LTEMP2+2 


FRACTIONAL PART OF FINAL ERROR 


146 


008D 


2005 




BRA 


INTKIE 


TERM WILL ALWAYS BE or 0.5 


147 


008F 


CC8000 


JMHAFI 


LDD 


#$8000 




148 


0092 


DD02 




STD 


LTEMP2+2 




149 


0094 


DCOO 


INTKIE 


LDD 


CMNDVX 




150 


0096 


9300 




SOBD 


LTEMP2 




151 


0098 


1302800B 




BRCLR 


LTEMP2+2, #$80, NOFCN 




152 


009C 


DDOO 




STD 


LTEMP2 




153 


009E 


1A830000 




CPD 


#$0000 




154 


00A2 


2F0B 




BLE 


NGFLG3 




155 


00A4 


830001 




SUBD 


#$0001 




156 


00A7 


DDOO 


NOFCN 


STD 


LTEMP2 


CMNDVX - ((ADRCX + ADRCXMD/2) 


157 


00A9 


2B04 




BMI 


NGFLG3 


SET OP SIGN FLAG IN TEMP3 


158 


00AB 


8600 




LDAA 


#$00 




159 


00 AD 


2002 




BRA 


NGFLG2 




160 


OOAF 


86FF 


NGFLG3 


LDAA 


#$FF 




161 


00B1 


9700 


NGFLG2 


STAA 


TEMP 3 




162 


00B3 


86C0 




LDAA 


#$D0 


SET ALO FOR SIDIV TO FORM 


163 


00B5 


DD4 4 




STD 


ALOC 


KINOM/KIDEN 


164 


00B7 


8601 




LDAA 


#$01 


CLEAR ACF 


165 


00B9 


9749 




STAA 


ALDF 




166 


OOBB 


CCOOOO 




LDD 


#$0000 


SET OP KI NOMERATOR 


167 


OOBE 


DD40 




STD 


CREGH 




168 


OOCO 


DCOO 




LDD 


KINUM 




169 


0OC2 


DD42 




STD 


CREGML 




170 


00C4 


DCOO 




LDD 


KIDEN 




171 


00C6 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


172 


00C8 


134901FC 


WIDIV1 


BRCLR 


ALDF,#$01,WIDIV1 


WAIT FOR ACF 


173 


OOCC 


8601 




LDAA 


#$01 


CLEAR ACF 


174 


OOCE 


9749 




STAA 


ALOF 




175 


OODO 


8 6E8 




LDAA 


#$E8 


TRIGGER SFDIV 


176 


00D2 


DD44 




STD 


ALOC 




177 


00D4 


134901FC 


WIFDV1 


BRCLR 


ALDF, #$01,WIFDV1 


WAIT FOR ACF 


178 


00D8 


DC40 




LDD 


CREGH 




179 


OODA 


DDOO 




STD 


LTEMP3 




180 


OODC 


DC42 




LDD 


CREGML 




181 


OODE 


DD02 




STD 


LTEMP3+2 




182 


OOEO 


8 6C0 




LDAA 


#$D0 


SET ALO FOR SIDIV TO FORM 


183 


00E2 


DD44 




STD 


ALOC 


PERDTNOM/PERDTDEN 


184 


00E4 


8601 




LDAA 


#$01 


CLEAR ACF 


185 


00E6 


9749 




STAA 


ALOF 




186 


00E8 


CCOOOO 




LDD 


#$0000 


SET OP PERDTNOM 


187 


OOEB 


DD40 




STD 


CREGH 




188 


OOED 


DCOO 




LDD 


PERDTNUM 




189 


OOEF 


DD42 




STD 


CREGML 




190 


00F1 


DCOO 




LDD 


PERDTDEN 




191 


00F3 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


192 


00F5 


134901FC 


WIDIV2 


BRCLR 


ALOF,#$01,WIDIV2 


WAIT FOR ACF 


193 


0OF9 


8601 




LDAA 


#$01 


CLEAR ACF 


194 


OOFB 


9749 




STAA 


ALOF 




195 


OOFD 


86E8 




LDAA 


#$E8 


TRIGGER SFDIV 


196 


OOFF 


DD44 




STD 


ALOC 




197 


0101 


134901FC 


WIFDV2 


BRCLR 


ALOF, #$01,WIFDV2 


WAIT FOR ACF 


198 


0105 


DC40 




LDD 


CREGH 




199 


0107 


DDOO 




STD 


LTEMP4 




200 


0109 


DC42 




LDD 


CREGML 




201 


010B 


DD02 




STD 


LTEMP4+2 




202 


010D 


DCOO 




LDD 


LTEMP3 


NOW FORM LTEMP 2 * LTEMP3 *LTEMP 4 


203 


010F 


DDOO 




STD 


LTEMP5 




204 


0111 


DC02 




LDD 


LTEMP3+2 
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205 


0113 


DD02 




STD 


LILMP D +Z 




206 


0115 


DC0O 




LDD 


Llii-MP 4 




207 


0117 


DD00 




STD 


T T* TT* Hjl T~) /T 

LTEMP 




208 


0119 


DC02 




LDD 


LTEMP 4 +2 




209 


011B 


DD02 




STD 


LTEMP6+2 




210 


011D 


9600 




LDAA 


TEMP 3 


SAVE SIGN FLAG 


211 


011F 


9700 




STAA 


TEMP 4 


AND UbL IilMPJ Ab A r LAG 


212 


0121 


8 600 




LDAA 


U- C A A 

#500 


FOR LTEMPo BEING POS1T1VL 


213 


0123 


9700 




STAA 


TIT 1 mfT""l i 

TEMP 3 




214 


0125 


BDQ23A 




JSR 


MULLNG 


UU LI tMP J * L1LMP 4 (PLKul^Kl) 


215 


0128 


DC00 




LDD 


L1EMP / 


xt^m d tit DircnT t tm t tttmdc: 
NUW PU1 KCibULl IN LlhMrO 


216 


012A 


DD00 




STD 


t t t mt") c; 




21 / 


U l^L. 


DC02 




LUU 


T TTMD "7 j_ O 




218 


012E 


DD02 




blU 


L1LMP 3+^ 




219 


0130 


9600 




LDAA 


TEMP 4 


KE1R1EVL SIGN r LAG 


22 


0132 


9700 




STAA 


tit 1 nif n 

TEMP 3 




221 


0134 


DC 00 




LUU 


T ttmo o 




222 


013 6 


DD00 




STD 


LTEMP 6 


ERROR FOR KI TERM 


223 


0138 


DC02 




LDD 


LTEMP 2 +2 




224 


013A 


DD02 




STD 


LTEMP 6+2 




225 


013C 


BD023A 




JSR 


MULLNG 


DO RESULT*LTEMP2 


226 


13F 


DC00 




LDD 


LTEMP 7 




227 


0141 


DD00 




STD 


LTEMP 1 




228 


0143 


DD00 




STD 


KITRM 




22 9 


0145 


DC02 




LDD 


LTEMP 7 +2 




230 


0147 


DD02 




STD 


LTEMP 1+2 




231 


0149 


DD02 




STD 


KITRM+2 


ADD KI TERM INTO NEWDTY 


232 


014B 


BD0361 




JSR 


ADLNG 


KITERM DONE 


233 


014E 


39 




RTS 




RETURN 


234 














235 






********* 


ROUTINE TO DO KD TERM 


■* , ■* , *^r■lt*■*■■*'•**■ 


236 














237 


014F 


DC00 


DOKDT 


LDD 


ERRX 


FORM (ERRX - ERRM3X) 


238 


0151 


9300 




SOBD 


T*T) T*lH.r"l V 

ERRM3X 


+ 3* (ERRM1X - ERRM2X) 


23 9 


0153 


DD00 




STD 


TEMPI 




24 


0155 


DC00 




LDD 


T 1 Tl t> V 

ERRM1X 




241 


0157 


9300 




SUBD 


ERRM2X 




242 


015 9 


DD45 




STD 


AREGH 


r URM 3* ( LRRM1X — LRRM^X ) 


243 


15B 


8 680 




LDAA 


#580 




244 


15D 


97 44 




STAA 


ALUC 




245 


015F 


8601 




LDAA 


#$01 




24 6 


0161 


9749 




STAA 


ALUF 




247 


0163 


CC0003 




LDD 


ft £ A A A "3 

#5 003 




248 


0166 


DD4 7 




STD 


Tin T? s—TJ 

BREGH 




24 9 


0168 


1349U1FC 


WDMDL0 


BRCLR 


7\ T nir ft <S A 7 (VIT^MOT A 

ALUr , # 5U 1 , WDMU LU 


T«77l T T 1 Tr^TD A T 

WA11 f UK ALi 


250 


1 6C 


DC42 




LDD 


CK&GML 




251 


016E 


D300 




ADDD 


T* T \A T5 1 




1 C "1 


01 /0 


DD00 




STD 


L1LMFA 




T cr *3 


rtl TO 

U 1 I Z 


ZrJUz 




BMI 


\7/"* T T ff" C A 


CPT T7D CTPW TT 7A TM TTTMD7 
OSLl Ur olON r liALj liN liLMrJ 


254 


017 4 


2006 




BRA 


FUoGN 




255 


017 6 


8 6FF 


NGFLGS0 


LDAA 


* £ TT 

#5c r 




25 6 


a i "7 Q 
U 1 / o 


Q 1 n ri 

y / uu 




STAA 


TTMD "5 




257 


1 7 A 


zUUft 




BRA 






258 


Alio 
01 /C 


a bUU 


POSGN 


LDAA 


ff 5 U U 




2 o y 


A 1 ~J T 


q "7 n n 

y / uu 




STAA 


TTMD "3 




2 60 


0180 


Lt-UUUU 


KDFLGD 


LDD 


* <: A A A A 
ff 5 U UU U 




Z bl 


A 1 Q T 


UUUz 




STD 


lil iliWir r\T-<i 




bz 


U lOO 


o ouu 




LDAA 


ffyUU 




T £ "3 
2 DO 


A 1 Q "7 

Ulo / 


y / q 4 




STAA 






2 64 


A 1 Q Q 

u lo y 


y bui 




LDAA 


tt 9 U 1 




ZOO 


A 1 Q P. 
U 1 OD 


y i *i y 




STAA 






2 66 


18D 


C-L UU U b 




LDD 


4-C A A A C. 




^ b / 


A 1 Q A 






STD 






268 


0192 


DC00 




LDD 


PERDTNUM 




269 


0194 


DD47 




STD 


BREGH 




270 


0196 


134901FC 


WDMOL1 


BRCLR 


ALUF, #S01,WDMUL1 


WAIT FOR ACF 


271 


019A 


DC42 




LDD 


CREGML 




272 


019C 


DD00 




STD 


TEMP 2 




273 


019E 


86C0 


NOFCND 


LDAA 


#$D0 


SET ALU FOR SIDIV TO FORM 




MOTOROLA 

22 



AN1215/D 



274 


01A0 


DD44 




STD 


ALUC 


KDNUM/KDDEN 


275 


01A2 


8601 




LDAA 


#$01 


CLEAR ACF 


276 


01A4 


9749 




STAA 


ALUF 




277 


01A6 


ccoooo 




LDD 


#$0000 


SET UP KD NUMERATOR 


278 


01A9 


DD40 




STD 


CREGH 




279 


01AB 


DCOO 




LDD 


KDNUM 




280 


01AD 


DD42 




STD 


CREGML 




281 


01AF 


DCOO 




LDD 


KDDEN 




282 


01B1 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


283 


01B3 


134901FC 


WDDIV1 


BRCLR 


ALUF, #$01,WDDIV1 


WAIT FOR ACF 


284 


01B7 


8601 




LDAA 


#$01 


CLEAR ACF 


285 


01B9 


9749 




STAA 


ALUF 




286 


01BB 


86E8 




LDAA 


#$E8 


TRIGGER SFDIV 


287 


01BD 


DD44 




STD 


ALUC 




288 


01BF 


134901FC 


WDFDV1 


BRCLR 


ALUF, #$01,WDFDV1 


WAIT FOR ACF 


289 


01C3 


DC40 




LDD 


CREGH 




290 


01C5 


DDOO 




STD 


LTEMP8 




291 


01C7 


DC42 




LDD 


CREGML 




292 


01C9 


DD02 




STD 


LTEMP8+2 




293 


01CB 


8 6C0 




LDAA 


#$D0 


SET ALU FOR SIDIV TO FORM 


294 


01CD 


DD44 




STD 


ALUC 


PERDTDEN/ (PERDTNUM*6) 


295 


01CF 


8601 




LDAA 


#$01 


CLEAR ACF 


296 


01D1 


9749 




STAA 


ALUF 




297 


01D3 


CCOOOO 




LDD 


#$0000 


SET UP PERDTNUM 


298 


01D6 


DD40 




STD 


CREGH 




299 


01D8 


DCOO 




LDD 


PERDTDEN 




300 


01DA 


DD42 




STD 


CREGML 




301 


01DC 


DCOO 




LDD 


TEMP 2 




302 


01DE 


DD45 




STD 


AREGH 


TRIGGER SIDIV 


303 


01E0 


134901FC 


WDDIV2 


BRCLR 


ALUF,#$01,WDDIV2 


WAIT FOR ACF 


304 


01E4 


8601 




LDAA 


#$01 


CLEAR ACF 


305 


01E6 


9749 




STAA 


ALUF 




306 


01E8 


86E8 




LDAA 


#$E8 


TRIGGER SFDIV 


307 


01EA 


DD44 




STD 


ALUC 




308 


01EC 


134901FC 


WDFDV2 


BRCLR 


ALUF, #$01,WDFDV2 


WAIT FOR ACF 


309 


01F0 


DC40 




LDD 


CREGH 




310 


01F2 


DDOO 




STD 


LTEMP9 




311 


01F4 


DC42 




LDD 


CREGML 




312 


01F6 


DD02 




STD 


LTEMP9+2 




313 


01F8 


DCOO 




LDD 


LTEMP8 


NOW FORM LTEMPA* LTEMP 8* LTEMP 9 


314 


01FA 


DDOO 




STD 


LTEMP5 




315 


01FC 


DC02 




LDD 


LTEMP8+2 




316 


01FE 


DD02 




STD 


LTEMP5+2 




317 


0200 


DCOO 




LDD 


LTEMP9 




318 


0202 


DDOO 




STD 


LTEMP6 




319 


0204 


DC02 




LDD 


LTEMP9+2 




320 


0206 


DD02 




STD 


LTEMP 6+2 




321 


0208 


9600 




LDAA 


TEMP 3 


SAVE SIGN FLAG 


322 


020A 


9700 




STAA 


TEMP 4 


AND USE TEMP3 AS A FLAG 


323 


020C 


8600 




LDAA 


#$00 


FOR LTEMP 6 BEING POSITIVE 


324 


020E 


9700 




STAA 


TEMP 3 




325 


0210 


3D023A 




JSR 


MULLNG 


DO LTEMF 8 * LTEMP 9 


326 


0213 


DCOO 




LDD 


LTEMP 7 


NOW PUT RESULT IN LTEMP 5 


327 


0215 


DDOO 




STD 


LTEMP 5 




328 


0217 


DC02 




LDD 


LTEMP 7 +2 




32 9 


0219 


DD02 




STD 


LTEMP5+2 




330 


021B 


9600 




LDAA 


TEMP 4 


RETRIEVE SIGNED ERROR 


331 


021D 


9700 




STAA 


TEMP3 




332 


021F 


DCOO 




LDD 


LTEMPA 




333 


0221 


DDOO 




STD 


LTEMP 6 


ERROR FOR KD TERM 


334 


0223 


DC02 




LDD 


LTEMPA+2 




335 


0225 


DD02 




STD 


LTEMP6+2 




336 


0227 


BD023A 




JSR 


MULLNG 


DO RESULT* LTEMP A 


337 


022A 


DCOO 




LDD 


LTEMP 7 




338 


022C 


DDOO 




STD 


LTEMP 1 




339 


022E 


DDOO 




STD 


KDTRM 




340 


0230 


DC02 




LDD 


LTEMP 7 +2 




341 


0232 


DD02 




STD 


LTEMP 1+2 




342 


0234 


DD02 




STD 


KDTRM+2 



















AN1215/D 



MOTOROLA 

23 



343 


0236 


BD0361 


344 


0239 


39 


345 






346 






347 






348 






349 






350 


023A 


8680 


351 


023C 


9744 


352 


023E 


DC00 


353 


0240 


DD45 


354 


0242 


8601 


355 


0244 


9749 


35 6 


0246 


DC00 


357 


0248 


DD47 


358 


024A 


134901FC 


359 


024E 


DC42 


360 


0250 


DDOO 


361 


0252 


8601 


362 


0254 


9749 


363 


0256 


8680 


364 


0258 


9500 


365 


025A 


2B12 


366 


025C 


DC02 


367 


025E 


DD47 


368 


0260 


134901FC 


369 


0264 


DC40 


370 


0266 


DDOO 


371 


0268 


DC42 


372 


026A 


DD02 


373 


026C 


2022 


374 


026E 


ccoooo 


375 


0271 


9302 


376 


0273 


DD47 


377 


0275 


134901FC 


378 


0279 


CCOOOO 


379 


027C 


9340 


380 


027E 


2B02 


381 


0280 


2003 


382 


0282 


C30001 


383 


0285 


DDOO 


384 


0287 


CCOOOO 


385 


028A 


9342 


386 


028C 


DD02 


387 


028E 


8600 


388 


0290 


DC02 


38 9 


02 92 


DD45 


390 


02 94 


8 601 


391 


0296 


97 4 9 


392 


02 98 


8600 


393 


029A 


DC 00 


394 


02 9C 


DD47 


395 


02 9E 


13 4 901FC 


396 


02A2 


8680 


397 


02A4 


9500 


398 


02A6 


2A0F 


399 


02A8 


8 680 


/inn 
4 U U 


02AA 




401 


02 AC 


2B02 


402 


02AE 


2 007 


J 


noun 




404 


02B3 


9340 


405 


02B5 


DD40 


406 


0237 


DC40 


407 


02B9 


2B02 


408 


02BB 


2003 


409 


02BD 


C30001 


410 


02C0 


DDOO 


411 


02C2 


DC42 



JSR 
RTS 



ADLNG 



ADD KD TERM INTO NEWDTY 
KDTERM DONE 



SUBROUTINE TO MULTIPLY LONGS ( INTEGER £ FRACTION) 
LTEMP 5 * LTEMP 6=LTEMP 7 ONLY LTEMP6 CAN HAVE 
A NEGATIVE TERM TO HANDLE. 



MULLNG 



WMULL1 



WMULL2 



NEGFRAC 



WMULL3 



INTFIX1 
INTFIX2 



NXFRAC 



WMULL4 



FXINT 



DFXINT 



NFFIX 
PFFIX 



LDAA #$80 

STAA ALUC 

LDD LTEMP 5 

STD AREGH 

LDAA #$01 

STAA ALUF 

LDD LTEMP 6 

STD BREGH 

BRCLR ALUF, #$01, WMULL1 

LDD CREGML 

STD INT5 6 

LDAA #$01 

STAA ALUF 

LDAA #$80 

BITA TEMP 3 

BMI NEGFRAC 

LDD LTEMP 6+2 

STD BREGH 

BRCLR ALUF, #$01,WMULL2 

LDD CREGH 

STD INTFC56 

LDD CREGML 

STD INTFC5 6+2 

BRA NXFRAC 

LDD #$0000 

SUBD LTEMP 6+2 

STD BREGH 

BRCLR ALUF, #$01,WMULL3 

LDD. #$0000 

SUBD CREGH 

BMI INTFIX1 

BRA INTFIX2 

ADDD #$0001 

STD INTFC5 6 

LDD #$0000 

SUBD CREGML 

STD INTFC56+2 

LDAA #$00 

LDD LTEMP5+2 

STD AREGH 

LDAA #$01 

STAA ALUF 

LDAA #$00 

LDD LTEMP 6 

STD BREGH 

BRCLR ALUF, #$01, WMULL4 

LDAA #$80 

3ITA TEMP 3 

BPL DFXINT 

LDAA #$80 

BITA AREGH 

BMI FXINT 

BRA DFXINT 

LDD #$0000 

SUBD CREGH 

STD CREGH 

LDD CREGH 

BMI NFFIX 

BRA PFFIX 

ADDD #$0001 

STD FCINT56 

LDD CREGML 



SET ALU FOR SMUL 
AND MULTIPLY INTS 



CLEAR ACF 



TRIGGER SMUL 
WAIT FOR ACF 



CLEAR ACF AND DO NEXT MULT 

TEST TEMP 3 SIGN 
SEE IF ERR IS NEG 
TERM IS NEGATIVE 
GET FRAC NOT NEG 
TRIGGER SMUL 
WAIT FOR ACF 
SCALE AND STORE 



NEGATE FRAC 

TRIGGER SMUL 
WAIT FOR ACF 
NEGATE RESULT 
SCALE AND STORE 



GET FRAC AND MULTIPLY 
WITH POSSIBLE NEG INT 
CLEAR ACF 



TRIGGER SMUL 
WAIT FOR ACF 



SEE IF SIGN OVERFLOW 
ON FRACTION 



THIS SCALES FRAC 



d 1 7 
4 j. z 


02C4 






b 1U 


r t-lJN I o b+z 




413 


02C6 


8 601 




t n a a 


ff-? U 1 


mou nn rDar*cDan 
INUW UU rKAt'CKAt 


414 


02C8 


Q7 d Q 




STAA 


a T TTTT 


c t tt a d a mr 
tlili-AK ALr 


415 


02CA 


8 600 




T n a a 


f ?UU 




A 1 
4 -L D 


02CC 


Q7 d d 
J / 4 4 




STAA 


ALUC 


ctt nxicT/"Mrn mftt t tod 


417 


02CE 


8 680 




LDAA 


14QA 

ff •? ou 


TPCT TTDD CTPW 


418 


02D0 


9500 




D TT A 

ol IA 


myn o 
ltiMro 


C t? TT Tr CDD TC HIT 


4 1 :? 


n 9n? 


7 nnc 




BMI 


NFCF RAC 


IbKM 15 NLCaAl IVfcj 


42 


02D4 


DC02 




LDD 


lil tMir b+z 


/— C rp ITDB/^ MAT Hrr 

UiL.1 S KAt NU1 NlUL) 


42 1 


02D6 


DD47 








lKluljljK OlYlUli 


422 


02D8 


134 901 FT 


WMT7T T S 




a t nr *trn mmttt t ^ 
AliUr , ff>Ul, WMUIiIjO 


wa t t tt/~id am? 
Artl l r urs. Ate 


423 


02DC 


DC 40 




t nn 


c* r u 


c;^ a t tt awn ctodtt 
otrtlilii Ainu o iv>i\rj 


424 


02DE 


DD00 




tTn 

OiU 


ruoo 




425 


02E0 


2012 




Dp 7\ 
DM 


oUMMU li 




42 6 


02E2 


rrooon 

^ W *J U 




t nn 

LiUU 


ffPUUUU 


MTT^aTTT rosr 


427 


02E5 


9302 




ouou 


lilr^jyilr b+z 




42 8 


02E7 


DD4 7 








TD mmTD CMTTT 


42 9 


02E9 


i 7 4 qo i rr 


WMT7T T 


DDpT D 


AliUr , ff?Ul, WMULljb 


Ma t t rnn a ftr 
WA1 1 rUK Atr 


430 


02ED 


rrnnnn 

VJ <J \J \J 




t nn 

LiUU 


ff9 UUUU 


dttctttt 
NlCjAI Jl, KboUlil 






Q7 d n 




outsu 


/-"■Q tj> /~- rr 


COAT C AKTn CTADU 

SCALE AND SIORh 


432 


02F2 


DD00 




OIU 


CLOtJ 




433 


02F4 


DC00 




LDD 


TTVTTC: C. 
11M 1 J D 


tN<UW O ULYLW AliJ-i tr KuUUL, 1 o 


434 


02F6 


D300 




annn 

rtUUU 


r <~ 1IN 1 O b 


TMTC aDTT AT T CTfMTTn 
IN lo AKil, AliL b ItlNhL) 


435 


02F8 


D300 




annn 

rtUUU 


1 IN 1 C l,OD 


/"■aM thct ann ftd 
t AN J Uo 1 ADD Ur 


4 T (T 
4 O O 




nnnn 
uu u u 






T TTTMD O 




d 7 7 


uzr <w 


a o o u 




t n a a 

liUAA 


icon 


mnpT rnnv ot/^ht 

TEST ERRX SIGN 


1JO 


u^r Hj 


SOUU 




£31 1A 


mun o 
liMf J 


SEE IF FRACS ARE NEG 




mn n 


7R7 7 




DMT 




rmii^c a Ti tp xtt7<^ a t *r t jt* 

FRACS ARE NEGATIVE 


d d o 
4 4 U 


n 7 n 7 






T nn 


T ATT C Cj. O 
r t-lN 1 O O+Z 


T-\ /—v f-< T T TT 7TI 

POSITIVE 


4 3 1 


m n yl 


m no 




ADDD 


IN 1 r Lo b+z 




A AO 


UOUo 


7 c. n 7 




ore 






d d 7 
4 4 .3 




o n n o. 
z u u y 




OKA 


bUMr 0-1 




/I A A 
4 4 4 


n t n a 

U OUA 


Q IT 

or 


vr*r* a d i 


XGDX 




SAVE SUM 


d d S 
4 4 O 


UJUa 


r*^ n n n i 




t nn 

LiUU 


ft ^ U U U 1 


Ann /"* A T> D V T XTTH TMT 

AUU t AKKI IN 1U INI 


AAG. 
4 4 O 


n 7nir 


r>7 nn 
uo uu 




a nnn 
rtUUU 


T TPMD 1 
111 LMr / 




d d 7 

4 4/ 


n 7 1 n 

UOiU 


uu uu 




olU 


T TTTMD 7 




d d fi 
4 4 O 


n 7i 7 


OC 




ALiUA 




DTTTD TTTT7TT CTTM 


A A Q 
4 4 y 


n 7 1 7 

UOlO 


m n n 
u J uu 


o U nt 1 


a nnn 
AUUU 


r C0 b 




4 O U 


n 7i ^ 

UOlO 


nnn? 
uu u z 




CTn 
o 1 u 


T TTTMD "7 j. 
i-il ZtCIC / + Z 




4 J X 


UOl ' 


tOUZ 






Trrr^ a d o 




^ 7 


UOl J 


7 n a c, 
z U40 










< c-i 
4J J 


mi n 
UOln 


CC000 1 


r CCARz 


LDD 


JL rs 1*1 ri i 
ft5 01 


ADD CARRY INTO INT 


4 O 4 


m i tt 


m n n 

1JOUU 




ADDD 


T TTTMD 1 




/ICC 


noon 
U Jz U 


DD00 




STD 


lilmf / 




4o b 


0322 


2 03C 




BRA 


SMFCDP 




d ^ 7 
4 0/ 


UO-c 4 


/T*n n n n 


bUMNr C 


t nn 
bUU 


ftp uuu u 


^nUDT TTMCMT KTTT PD IVAO 

COMFLEMENi NEG FRACS 


A c; q 
4 O O 


n 7 7 7 

uoz / 


ao no 
y J Uz 




SUBD 


itlNlO b+z 




.ACQ 


u jz y 


nn n o 




STD 


FCINTo 6 + ^ 




/i c n 
4 bU 


7 


ccc\ n n n 




t nn 


ftp u UU u 




d 

4 01 


n 77 IT 


Q 7 n o 
y J Uz 




oUtSU 


1JN ir tO b + z 




4 bz 


uoou 


nn n o 
UUUz 




STD 


IN ir C-O b + z 




4 O J 


n 7 7 9 
uooz 


u u u u 




t nn 


ft P u u u u 




d C d 
4 O 4 


n 7 7 c. 


q 7 nn 
y j uu 




ennn 


CLjd 




A C ^ 
4 DO 


n 7 7 7 
UOJ / 


nnnn 
uu uu 




CTn 
biU 


IT^ ^ C 




d^C 
4 C O 


P) 77 Q 


nr*n7 

Uk, uz 




t nn 

LiUU 


Cr* TMT fC-u 7 
f tiWlODti 


Hilort IIVL 


d C7 
4 0/ 


(™l 7 7 TJ 

V JJU 


n 7 no 
uo uz 




a nnn 


iWif to b+z 




d CP 
4 O O 


n 7 7 n 
uoou 


z o uz 




arc 


a d 7 


DTTMTTMniTD CTrH DTT ! 1 
KCjIYlLiyioll.K bltaN Oil I ! 


4 69 


33F 


2009 




□ d a 


crrTMFP7 




47 




8F 


r ^Urtrs-S 


vrny 






471 


0342 


*w r r r r 




t nn 


ffyr fir 


ann rdrrow txito twt 

rtUU DKJt\t\\Jri Let 1U 1 ct 1 


477 

4 / Z 


0345 


D300 




ADDD 


T TFMP 7 

_ X i— i - x ■ 




4 / -J 


034 7 


nnnn 
uu uu 




OIU 


T TT^MP7 
Lil &rle t 




474 


034 9 


8F 




XGDX 




RETRTFVF SUM 

1 1\ 1 Li V L Jul! 


d7 R 

4 / O 


034 A 


D300 


o u L*ir z 


annn 


rujo 




476 


034C 


DD02 




STD 


LTEMP7+2 




477 


034E 


2502 




BCS 


FCCAR4 




478 


0350 


2007 




BRA 


SMFCDN 




479 


0352 


CCFFFF 


FCCAR4 


LDD 


#$FFFF 


ADD BORROW INTO INT 


480 


0355 


D300 




ADDD 


LTEMP7 





AN1215/D 



MOTOROLA 

25 



481 


0357 


DD00 


STD 


LTEMP7 




482 


035 9 


ccoooo 


SMFCDN LDD 


#$0000 


CONVERT BACK TO NEG 


483 


035C 


9302 


5DBD 


LTEMP7+2 




484 


035E 


DD02 


STD 


LTEMP7+2 




485 


0360 


39 


SMFCDP RTS 






486 












487 












488 






* SUBROUTINE TO 


ADD INTEGER AND 


FRACTION IN LTEMP1 TO OLDDTY * 


489 












4 90 


0361 


8680 


ADLNG LDAA 


#$80 


TEST ERRX SIGN 


4 91 


0363 


9500 


BITA 


TEMP 3 




4 92 


0365 


2B19 


BMI 


KXNEG 


TERM IS NEGATIVE 


493 


0367 


DC00 


LDD 


LTEMP1 


GET INT PART 


494 


0369 


D300 


ADDD 


OLDDTY 


ADD AND STORE INT 


4 95 


036B 


DD00 


STD 


NEWDTY 




496 


036D 


DC02 


LDD 


LTEMP1+2 


GET FRAC PART 


497 


036F 


D302 


ADDD 


OLDDTY+2 


ADD AND STORE FRAC 


498 


0371 


DD02 


STD 


NEWDTY+2 




4 99 


037 3 


2502 


BCS 


INCINT 






0375 


201E 


BRA 


ADDONE 




501 


0377 


CC0001 


INCINT LDD 


#$0001 


ADD CARRY FROM FRAC 




n T 1 a 


D300 


ADDD 


NEWDTY 




^ n *3 


Uo /C 


DD00 


STD 


NEWDTY 




504 


037E 


2015 


BRA 


ADDONE 




505 


0380 


DC00 


KXNEG LDD 


LTEMP1 


GET INT PART 


50 6 


0382 


D300 


ADDD 


OLDDTY 


ADD AND STORE INT 


507 


0384 


DDOO 


STD 


NEWDTY 




508 


038 6 


DC02 


LDD 


LTEMP1+2 


GET FRAC PART 


ju y 


0388 


D302 


ADDD 


OLDDTY+2 


ADD AND STORE FRAC 


510 


038A 


DD02 


STD 


NEWDTY+2 


ACTUALLY A SUBTRACTION 


511 


038C 


2507 


BCS 


ADDONE 




512 


038E 


CCFFFF 


DECINT LDD 


#$FFFF 


SUBTRACT BORROW FROM FRAC 


513 


0391 


D300 


ADDD 


NEWDTY 




514 


0393 


DDOO 


STD 


NEWDTY 




515 


0395 


DCOO 


ADDONE LDD 


NEWDTY 


UPDATE OLDDTY FOR NEXT TERM 


516 


0397 


DDOO 


STD 


OLDDTY 


OR FINISH 


517 


0399 


DC02 


LDD 


NEWDTY+2 




518 


039B 


DD02 


STD 


OLDDTY+2 




519 


039D 


39 


RTS 




RETURN TO CALLING ROUTINE 


520 


039E 




END 






Errors : 


None 


######### 






Bytes : 


926 


# DOPID # 






CRC 




EC21 


######### 







MOTOROLA 

26 



AN1215/D 



